#include "../_includes.h"

/////////////////////////////////////////////////////////
// --------------- 滚吸相关 -------------------------
// 操作方式：R1--吸取
//          R2--吐球
//          不操作--带速吸取
/////////////////////////////////////////////////////////////

// int SuckerState = 1;
// 和钩子相关的标志量（钩子放下后滚吸保持吸取，直到下一次操作滚吸）

extern bool autochain;

void handle_suck()
{
    if (ctrl.ButtonR1.pressing())
    {
        suck.set_voltage(100);
    }
    else if (ctrl.ButtonR2.pressing())
    {
        suck.set_voltage(-100);
    }
    else
    {
        suck.set_stopping(coast);
        suck.stop();
    }
}

void handle_chain()
{
    if (!autochain)
    {
        if (ctrl.ButtonR1.pressing())
        {
            chain.set_voltage(100);
        }
        else if (ctrl.ButtonR2.pressing())
        {
            chain.set_voltage(-100);
        }
        else
        {
            chain.set_stopping(brake);
            chain.stop();
        }
    }
}